package cn.gwm.utils;

import java.math.BigDecimal;

/**
 * @author Liu.Nanfang
 * @date 2022/9/7 15:59
 * @description 根据经纬度计算两点直接的距离
 */
public class DistanceUtils {

    /**
     * 计算地球上任意两点(经纬度)距离
     *
     * @param long1 第一点经度
     * @param lat1  第一点纬度
     * @param long2 第二点经度
     * @param lat2  第二点纬度
     * @return 返回距离 单位：米
     */
    public static double distance(double long1, double lat1, double long2,
                                  double lat2) {
        double a, b, R;
        // 地球半径
        R = 6378137;
        lat1 = lat1 * Math.PI / 180.0;
        lat2 = lat2 * Math.PI / 180.0;
        a = lat1 - lat2;
        b = (long1 - long2) * Math.PI / 180.0;
        double d;
        double sa2, sb2;
        sa2 = Math.sin(a / 2.0);
        sb2 = Math.sin(b / 2.0);
        d = 2
                * R
                * Math.asin(Math.sqrt(sa2 * sa2 + Math.cos(lat1)
                * Math.cos(lat2) * sb2 * sb2));
        return d;
    }

    /**
     * 两点之间距离 单位千米
     *
     * @param long1 第一点经度
     * @param lat1  第一点纬度
     * @param long2 第二点经度
     * @param lat2  第二点纬度
     * @return 两点之间距离 单位千米
     */
    public static double distanceKm(double long1, double lat1, double long2,
                                    double lat2) {

        return DistanceUtils.distance(long1, lat1, long2,
                lat2) / 1000;
    }

    public static void main(String[] args) {
        double lng1 = 116.434395;
        double lat1 = 39.862268;
        double lng2 = 116.434651;
        double lat2 = 39.862542;
        double distance = distance(116.38535, 39.846305, 116.393184, 39.846444);
        System.out.println("distanc:" + distance);
        System.out.println("distancKm:" + distanceKm(lng1, lat1, lng2, lat2));
    }


    public static double distance(BigDecimal long1, BigDecimal lat1, BigDecimal long2, BigDecimal lat2) {
        return DistanceUtils.distance(long1.doubleValue(), lat1.doubleValue(), long2.doubleValue(),
                lat2.doubleValue());
    }
}
